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ABSTRACT 


The angular momentum of a free-flying multibody system in 
space is a conserved gueuitity. This conservation law acts as a 
nonholonomic constraint and manifests itself when cyclic motion of 
the articulated joints of an on board manipulator produces a net 
change in the orientation of the whole system. This poses two 
important and coupled problems: (a) the motion planning problem of 
the manipulator for attitude reorientation of the space structure 
using internal motion of the joints, cmd (b) planning the 
manipulator joint trajectories that produce repeatable motion of 
all the configuration variables. We have adopted a surface 
integral approach to come up with algorithms for these nonholonomic 
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I. INTRODUCTION 


There is a growing interest in the area of attitude 
control and motion planning of multi-body systems in space. 
These structures in space are expected to have attached 
articulated joint manipulator arms on board. A problem 
arises for these structures in that the movement of the 
manipulator arm will cause a displacement for the whole 
structure. This displacement is a result of the dynamic 
coupling between the arm and the structure. Multi-body 
systems in space, in the edjsence of external forces, conserve 
the angular momentum of the system. This conservation acts as 
a nonholonomic constraint on the motion of the system. For 
structures with attached manipulator arms, this conservation 
law manifests itself when cyclic motion of the manipulator 
joints produce a net change in the orientation, i.e., a drift 
in the orientation, of the whole system. Changes in system 
orientation can also arise from other causes such as: (l) 
differential gravitational forces; (2) solar radiation 
effects; (3) dynamic interactions between a space station and 
on board robots or a docking shuttle craft; and, (4) the 
operation of booster rockets used for orbit maintenance [Ref. 
201 . 
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An extensive literature survey will lead one to believe 
that the best way for attitude control would be to use 
momentxiin exchange devices with control momentum gyroscopes as 
the most desirable devices for attitude control. 

Though the most desirable devices, gyroscopes have some 
disadvantages which are: (l) they require a steady power 
source to overcome the dissipated energy of the friction in 
the bearings; (2) susceptibility to mechanical failure as a 
result of its constant motion; and, (3) a significant added 
weight effect. Other devices such as booster rockets and gas 
jets have the disadvantage of: (l) requiring onboard fuel 
storage which adds a considerable weight effect; and, (2) fuel 
sources that once eaqiended are non-replenishable without a 
consideraible monetary expense. 

If manipulators can effectively be used to reorient a 
space structure, they Ccui serve as a reliable back-up means of 
attitude control in the event of a power interruption or 
mechanical failure of the gyroscope. In the case of a small 
satellite with an attached manipulator where the added mass of 
a gyroscope or booster rocket fuel is undesirable, the 
manipulator can serve the dual purpose of attitude control and 
automation in space. 

The advantages of the manipulator are: (1) they are 
already aboard; (2) require much less power than momentum 
exchange devices; (3) are less susceptible to mechanical 
failure; and, (4) use of the manipulators internal controls 
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does not modify the total angular momentum of the system [Ref. 
24] . 

A related issue to using a manipulator arm to reorient a 
space structure is that, due to the nonholonomic nature of the 
structure, the use of a manipulator to perform a required task 
may result in a undesiraJale change in the orientation of the 
structure. It thus becomes desirable to be able to predict 
and control the change in orientation of a freely-floating 
space structure. The ability to predict and control this 
change is the subject of this thesis. 

Some of the earliest work in the study of the motion 
planning problems of nonholonomic systems has been done by 
Kane and Scher [Ref. 12] , who studied the falling cat problem, 
and Kane, Hedrick and Yatteau [Ref. 11] , who studied the 
astronaut maneuvering scheme. 

More recently the study of the use of manipulators for 
reorientation of space structures has been done by Vafa and 
Dubowsky [Ref. 29] , where cyclic motion of the joint variables 
were proposed to reorient the space vehicle, and Fernandes, 
Gurvits and Li [Ref. 4] proved the controllability of a space 
robot system using a three link manipulator. This work 
motivated Nakamura and Mukherjee [Ref. 22] , who proposed a bi¬ 
directional approach to the motion planning of free-flying 
space robots to control both the space vehicle orientation and 
the manipulator joints by actuating only the manipulator 
joints. Conversely, Yeunada and Yoshikawa [Ref. 32] prescribed 
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an arm trajectory and then found the optimal trajectory that 
yielded the desired attitude change with the minimum arm 
movement. Walsh and Sastry [Ref. 31] provided kinematic 
algorithms for reorienting some systems of linked rigid bodies 
floating in space. 

Other studies on the control, stabilization, 
repeatability, drift and motion planning for reorientation of 
linked multi-bodied stoructures in space can be found in the 
reference section. 

This thesis follows on with work done by Mukherjee and 
Anderson [Ref. 19] , wherein they proposed a method of the 
surface integral approach for planning the motion of a two 
dimensional nonholonomic system. 

In this thesis we present two concepts. The first is an 
algorithm for the motion planning of a space manipulator to 
achieve attitude control of a freely-floating three 
dimensional space structure. Generally stated the algorithm 
provides a means for calculating the coordinate trajectories 
required to drive a nonholonomic system from one point in its 
configuration space to some other desired point. The 
algorithm invokes the use of Stokes' Theorem and, therefore, 
takes a surface integral approach to the problem as is done in 
[Ref. 20] . 

Secondly, we present a means of determining the 
manipulator motion required for the nonholonomic freely 
floating space structure to behave in a holonomic manner 
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globally, which we call "pseudo-hoionomic behavior" [Ref. 21] . 
The method determines if "holonomic loops" [Ref. 21] do exist, 
where the system exhibits holonomic behavior globally for 
particular paths in the configuration space of the 
nonholonomic system. The planar space robot is the system 
studied and its configuration space is the joint space of the 
manipulator. If a "holonomic loop" does exist, wc present an 
algorithm for finding that loop within the configuration 
space. 

This thesis is organized as follows: 

Chapter II presents some mathematical preliminaries 
necessary for understanding the behavior of nonholonomic 
systems. 

Chapter III studies the freely floating three dimensional 
space structure with an attached three link manipulator as 
shown in Figure 1.1. The problem to be solved is to change 
the orientation of the structure from one configuration to 
another configuration by moving the manipulator arm joints 
along pre-planned paths. An example of the initial and final 
orientations of the structure are as shown in Figure 1.2. 
Chapter III provides an algorithm for planning the path of the 
manipulator joints necessary to achieve a desired change in 
orientation of the structure. Once the path is planned a 
simulation is conducted to illustrate that manipulators can 
indeed reorient a space structure. 
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Chapter IV studies the freely-floating planar space robot 
with an attached two link manipulator arm as shown in Figure 
1.3. The problem to be solved is how to plan the path of the 
manipulator arm joints such that the space robot will not 
reorient itself in space. This amounts to finding the path in 
space for the manipulator arm where the planar space robot 
exhibits holonomic behavior globally. Chapter IV provides an 
algorithm for planning the path of the manipulator joints that 
will allow the planar space robot to regain its original 
orientation after the manipulator motion is complete. Once 
the path is planned a simulation is conducted, illustrating 
that repeatable motion is possible for nonholonomic systems. 

Chapter V presents conclusions and recommendations. 
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Figure 1.3 A Planar Space Robot With Two Links 
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II. MXTHSIUITICAL PRBLIMIIIARIES 


A. RELEVANT THEOREMS 

A review of a few mathematical theorems is necessary to 
understeuid how nonholonomic systems behave and the problem 
solutions which we propose. The first theorem concerns the 
exactness euid integred)ility of a differential equation. The 
second concerns the path independence of line integrals. 
Finally, the third is Stoke's Theorem, which transforms line 
integrals into surface integrals. 

1. Theorem 1: Exactness [Ref. 5] 

A differential expression of the form 

M{x, y,z)dx * N(x, y, z) dy + P(x, y, z)dz /*>. 11 


is exact on a dcnnain D in space if. 


Mdx + Ndy + Pdz 


^dx 

ax 


df 




( 2 - 2 ) 


for some (scalar) function f throughout D. The differential 
form Equation (2-1) is exact, if and only if; 


dP^dN dM ^ dP dN _ ^ 

■ 5 ^ ai ' dy ' 


(2-3) 
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It is a well established fact that a differential 
expression is integrable, if it is exact or can be made exact, 
by multiplying it by an integrating factor. In other words, 
exactness iir^lies integradjility. Therefore, it follows that 
non-integreLbility inplies non-exactness. Exactness is also a 
necessary and sufficient condition for path independence of 
line integrals. This is stated formally next. 

2. Theorem 2 1 Exactness and Independence of Path 

[Ref. 14] 

Let f(x,y,z), g{x,y, 2 ) euid h(x,y,z) be continuous 

functions in a domain D in space, then the line integral is 

+ gdy + hdz) (2-4) 

is independent of the path C in D, if and only if, the 
differential form under the integral sign in Equation (2-4) is 
exact in D. Additionally the line integral is independent of 
path in D if and only if it is zero on every simple closed 
path C in D. 

A line integral over a closed path C can be converted 
the into a surface integral utilizing the well known Stoke's 
Theorem [Ref. 2]. 

3. Theorem 3: Stoke's Theorem [Ref. 2] 

If D is a k-dimensional space and w is a (k-l) 
differential form on D, then from Stoke's theorem we have 
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f (a - f d<ji 

Jao Jd 


(2-5) 


where, 9D is the path of the line integration and is the 
boundary of the domain D, and dw is a differential k form, 
obtained by the exterior differentiation of u. 

B. MBNIFESTATIQN OF 1I0IIH0L0NGM7 

The is^ortance of theorem 2 lies in the fact that 
nonholonomic systems are governed by non-integredsle and, hence 
non-exact differential constraint equations. Nonholonomic 
systems are, therefore, path dependent. To illustrate path 
dependency consider the following ecpiatlon: 

dp = v^dx + Vjdy + v^dz ( 2 - 6 ) 

Where: .(1) p is the dependent varicdble of a nonholonomic 
system; (2) x, y emd z are the independent variables; and, (3) 
V 2 euid V 3 are continuous fxmctions of x, y cuid z. Since 
the system is non-integrcd)le the differential form, 

Vj^dx + Vjdy + V3dz 

is not exact. Therefore, by theorem 2 the change in p is path 
dependent. Hence, it is possible to change the coordinates of 
the dependent variable p, by using closed trajectories of the 
independent variables, as shown in Figure (2.1). The 
independent variad>les, which trace the closed path C, start at 
point two, move around the path amd return to point five. 
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coincident with point two. The independent variables have 
returned to their original value, whereas the dependent 
variable p has taken on a new value, p + Ap. Path dependency 
is a characteristic of nonholonomic systems, which we will use 
to reorient a structure in space using angular momentvim 
preserving controls; this is considered next. 

C. THE SURFACE INTEGRAL APPROACH: ATTITUDE CONTROL 

In Chapter I, we have seen that freely floating structures 
in space are nonholonomic systems. The nonholonomy arises 
from the fact that the conservation of angular momentvim yields 
non-integrcd>le constraints of motion. It is this non- 
integrsdaility that permits the reorientation of the structure 
while maintaining a zero value of angular momentum. 

In the case of an articulated space structure, the 
nonholonomic constraint equations relate the rate of change of 
the dependent variables, the structure orientation, to the 
rate of change of the independent variables, the angles of the 
articulated arms. To achieve the desired change in the 
orientation of the structure, we need only find the correct 
path in the configuration space of the independent variables, 
the joint angles, to yield the desired change in the dependent 
variables, the orientation of the structure. We can find this 
path by methodically utilizing the surface integral approach 
to solve for the closed path. 
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The nonholonomic motion constraint equation for the 
articulated structure can be expressed in a differential form. 
Integration of this differential form, to obtain the change in 
the dependent variable, amounts to solving the line integral 
of the equation in the space of the dependent varicJales. The 
surface integral approach utilizes Stoke's theorem to convert 
the line integral into a surface integral. This approach 
sin^lifies the mathematics and allows us to appropriately 
choose a surface area, which will yield the desired change in 
the dependent variod)le. Once the surface area is chosen, the 
path enclosing the surface area can be fo\and by setting the 
limits of integration. The change in the dependent variables 
can now be found as a function of the limits of integration. 
By choosing the limits of integration, we have the ability to 
satisfy additional constraints, such as the limits on the 
values of the independent variables. 

To illustrate this, consider an arbitrary space structure 
as previously shown in Figure 1.1 with an attached manipulator 
arm. Suppose that the manipulator has constraints on its 
motion, such as joint limits or work space limitations. Now 
suppose we wish to reorient the structure by an amount where 
0 * nk, where n = 1,2, ..., euid k is the change in orientation, 
as the manipulator traverses a path c. By appropriately 
setting the limits of integration, we can choose our surface 
such that we reorient the structure by traversing a path C one 
time or traversing a smaller path c, n times. The manipulator 
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motion can then be planned amidst additional constraints, 
such as manipulator joint limits and environmental work space 
limitations. The surface integral approach will be presented 
in detail in Chapter III. 

D. THB NECESSARY CONDITION FOR REPEATABILITY 

The property of repeatability of a system is that, when 
the independent variadiles move along closed trajectories, the 
dependent variables also move along closed trajectories. 
Repeatability is ensured if the differential constraints of 
motion of a system are integrable and, hence, are path 
independent. Naturally holonomic systems exhibit this 
property. 

The purpose of Chapter IV is to demonstrate that: (1) 
integraibility of the differential constraint is only a 
sufficient condition for repeatability, but it is by no means 
a necessary condition; and, (2) that a necessary condition for 
the repeatable motion of a nonholonomic system is as follows: 

Consider a two dimensional path dependent system where 6q 
is the dependent variedjle and and B 2 are the independent 
variables- Suppose also that the dependency of on B^ and 
B 2 is explicitly given by the following equation: 

d^o * + 92^^2 <2-7) 
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where and 93 are functions of 6^ and ^ 2 * change in the 

dependent variable is given by the line integral. 


/c«o = / 9^2^23 



- d8,Ad6j 

OO 2 

- -^1 (dBiAdBj) -o 


( 2 - 8 ) 


applying Stokes' theorem yields. 





(2-9) 


where "A" denotes the exterior product, denotes the dot 
product and a, the orientation of D has the same orientation 
as cbc 2 AdX 2 when the direction along the path is 
counterclockwise, otheirwise a has the same orientation as 
dx^dx^. For a nonholonomic system, 

301 302 


hence, we define 


(■& - -S) * F(6i,e,) 


( 2 - 10 ) 
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substituting into Equation (2-9) we get 
r dBo * f F(ei,e2)dBiC®2 

JdD J D 

= f(0,‘,02‘)/^d0iC©2 

= F(0i*,02*)lC(i?) , (0 i’,02*)€Z? 

Equation (2-10) was obtained by the application of the meeui 
value theorem of integral calculus. The function F Ceui be 
shown to be continuous in the entire domain D euid, hence, the 
mecm value theorem applies. euid $ 2 * denote some point 

within the domain D; eind, ir(D) is the measure of the domain D; 
In this case it is sinqply equal to the area enclosed within 
the closed curve dD. Fi 6 ^*, 62 *) can also be interpreted as the 
meaui value of the function F, defined by Equation (2-10), 
teUcen over the domain D. If this meam value happens to be 
zero, then we would have no net change in the dependent 
variable as the independent variables move along closed paths 
and return to their original value. Hence, we have a 
nonholoncxnic system that exhibits pseudo holonomic behavior. 
We will apply this concept to a planar space robot in Chapter 


IV. 





X 


(1) = (xfyfzfpQ) 

(2) * (XQ, yo. zq, Po+ 5p) 

(5) = (xo^yo.zo’Po-^P + ^P) 

(6) * (xfyfzfpp + Ap) 
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Figure 2.1: 


The Closed Trajectory C in the Independent 
Variables X, Y, and Z Produces a Change in 
the Dependent VarieUsle P by em Amoxint dp. 



Ill'/ THE SURFACE INTEGRAL APPROACH: ATTITUDE CONTROL 


A. INTRODUCTION AND NOMENCLATURE 

In Chapter I, we saw that for a freely-floating space 
structure with an attached manipulator arm that if the 
manipulator can effectively be used to reorient the structure 
then manipulators can serve: (1) as a reliable back-up to 
gyroscopes; and, (2) the dual purpose of attitude control and 
automation in space. 

In this chapter, we develop the algorithm for attitude 
control of a space structure using a three link manipulator 
and present the results of the simulations. We assume the 
robot to have a PUMA type structure as shown in Figure 3.1(a) , 
and the reference frames are according to the Denavit- 
Hartenburg [Ref. 3] convention. Figure 3.1(b) shows the 
kinematic structure of the manipulator. For mathematical 
sin^licity: (1) the center of mass of the system was chosen to 
coincide with the geometric center of the body; and, (2) the 
inertial and body fixed axes were ''•hosen to be coincident at 
point S. 

The following nomenclature is used throughout the 
development: 

frame J Inertia frame. 


19 






frame S 


Frame fixed at the center of mass of the 
space structure and directed along the 
principal axes of the structure. 

frame K The Jc-th kink frame of the manipulator 

according to the Denavit-Hartenburg [3] 
convention, k * 0 denotes the manipulator 
base frame. 

ni]^ Mass of the k-th body for k = 1, 2, 3... 

the mass of the space structure is (kg ). 

Inertial matrix of the k-th body about the 
principal axes located at the center of 
mass, and expressed in the k-th link 
frame. The inertia matrix of the space 
structure is denoted by ®Ig, (kgjiP). 

(i,j)-th element of (kga^) . 

^otYot^o Position of the center of mass of the 

space structure in the inertia frame (m). 

01»02'^3 y~^~y Euler angles, describing the 

orientation of the space structure with 
respect to the inertia frame. 

/Sq,,/S 2 /i ®3 Euler parameters [Ref. 10] . 

R[*,*] € R^*^ Orthogonal rotation matrix corresponding 

to a rotation of the (•) axis fixed on the 
space structure by an angle (*). 

Joint configuration of the three link 
manipulator. 

B. ALGORITHM FOR MOTION PLANNING 

The cuigles and parcuneters of interest in the development 
of the algorithm for motion planning are: (1) Euler angles, 
describing the orientation of the space structure; (2) Euler 
parameters; and, (3) the joint angles of the manipulator. The 
"home" euid "intermediate" configurations of the manipulator 
are as shown in Figure 3.2. The "home" configuration is 
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defined as 6 ^, $ 2 , and ^3 equal to zero degrees where 6 ^, $ 2 , 
and $2 are the joint angles of the first, second, and third 
links, respectively. The "intermediate" configuration is 
defined as 6 -^ equal to ninety degrees and 62 and ^3 equal to 
zero degrees. 

The reorientation of the space structure will be achieved 
through rotations of the structure about the body fixed x, y, 
and z axes. Our goal is to change the orientation of the 
space structure from an initial set of Euler angles 02 i' 
<l> 2 i to a desired set of values <t> 2 f, <l> 2 f without any change 
in the system configuration. In other words, we would like 
the manipulator to have the same joint configuration { 6 ^, 62 , 
d 3 ),say the "home" configuration, when the orientation of the 
structure is { 4 >x,<t> 2 ><t^ 3 ) ■ • The 
initial and final configurations are given in Figure 3.3. 
Three classes of motion are defined as follows: 

(1) Y - Class motion 

The purpose of the class Y motion is to change the 
orientation of the space structure about its' Y^ axis 
using the manipulator. The manipulator will be at the 
"home" configuration at the beginning and end of this 
motion. Furthermore, during this motion the first joint of 
the manipulator will be kept fixed at 6 ^ = 0.0 radians. 
The motion of the nicuiipulator will, therefore, remain 
confined to the plane, and the problem will reduce 
to a pleuiar problem. 

(2) Z - Class motion 

The purpose of the class Z motion is only to reconfigure 
the manipulator. It will be used to bring the manipulator 
to the "intermediate" configuration from the "home" 
configuration, and vice versa. The reconfiguration will 
be achieved by using only the first joint of the 
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manipulator. The second and third joints of the 
manipulator will be held fixed at {$ 2 , ^ 3 } * ( 0 , 0 ) during 
this motion. The motion of the manipulator will, 
therefore, remain confined to the Xg-Yg plane. Note that 
the Z-class motion is a holonomic motion because only one 
manipulator joint is involved in this motion. 

(3) X - Class motion 

The purpose of the class X motion is to change the 
orientation of the space structure about its' Xg eocis 
using the manipulator. The manipulator will be at the 
"intermediate" configuration at the beginning euid end of 
this motion. Furthermore, during this motion the first 
joint of the memipulator will be kept fixed at » ir 
radians. The motion of the manipulator will, therefore, 
remain confined to the Yg-Zg plcine. 


To reorient the structure there are twelve possible 
combinations of rotations about the body fixed sixes. The 
scheme chosen for this problem was to sequentially rotate the 
structure about its' y-x-y axes. 

1. Y • Class Notion 

The chemge in orientation, rotation of the structure 
about its' Fg axis is given by the nonholonomic angular 
momentum constraint equation as follows: 


i = (aij + bij) , 


(3-la) 


a A CiSinSj + CjCosO, + CjSinOj +63) + Sj , 

b s CjCosOj + C3sin(02 +83) + Sj , 

A 4 2CiSin02 C^cosO, 2C^sin(62 + 63) - s, , 
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where the constants C^, C^, C^, s^/ 82 and S3 are defined as. 


q A 1^(0.Sm^ + iHj) [^^(r ♦ ij) + o.sqij , 

q k + O.Bin^) , 

q A O.Ssijij [in^Cr + ii) + 0.5qii] , (3-lb) 

Si A + (0.25sij + 013)1^] - iO.Sm^ + , 

S 3 A + 0.25in3i3*] - Q.2Sn^ll , 

S 3 A -m^ils22 * A 33 ■*■ (r + ii)* + jn^Cr + O-Blj)*] 

-[q(r + O.Sii) * (iJ^ + iJ^) (r + ij) - Sj , 


and where, mj. « ( * m2 + m^), amd r, I2/ I2 and I3 are 
defined in Figure 3 . 1 (b). Equation ( 3 -la) gives the cuigular 
velocity of the structure about its'lf^ aixis as a function of 
the joint configuration amd joint velocities. 

If the second amd third joints of the manipulator move 
along a closed path C in the 02 ~^3 plane, then the net chamge 
of orientation of the spacecraft about its' Yg eucis is given 
by; 




23 








where, S is the surface area enclosed within the closed curve 
C. Choosing the surface area S to be rectangular, to simplify 
the integration, and specifying three of the four limits of 
integration we Ccui solve for the chamge in orientation as a 
function of the fourth limit of integration. The fourth, auid 
unknown, limit of integration was chosen as ^20* After 
integrating, the final eaqpression for the change in 
orientation, as a function of 62■^^, Equation ( 3 - 3 ) was 
obtained. 


♦y = 

_^C^cos^ S3 -2qsin6;„ -2Cacose^^ 

V5 ^ S3-C2-2(C3 + C3)sin62u 2V5 

^ 2 [S3Vs ♦ (S3 -2qsinea„) vj ^ 


arctan ( 8in62„-2C^cosB3„ ^ 


2 [S3V5 + (S3 -2q8i nea„)vJ ^ -2qcose3„ ^ 




-11 f Ji 

V2 2 


[^■Kln( 


2 ^ 3-53 

q-S 3 


)] 


(3-3a) 


2(S2V2 + S,v;) , , 2 q-q-S 3 , ^ , 2 C 3 ,, 

+-=- 3 —.~i - larctan ( —■■■■ — —-) -arctan (—-) ] 

V2V3 V3 V3 

S3+2S, - ^ . 2q-(83+203)tan(02„/2) /2q.- 

+-^-i [arctan(—-^:-2-2-22-) -arctan(—1) ] 


V7 


V7 


s3+2s3 + q_2(q+q) + (q-Sj) t 2 ui( 82 u/ 2 ), 

' ' ' ■ —• OX WUCUl V ' 1 i—T- f 


s3+2s,+q ^ ,2(C3+q). 

__3 -l---iarctan(- ^ ■ ) 
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with 


A Cj* + 2C3* , 

V2 4 + 4C3* , 

Vj* 4 S3* - - 4C3* , (3-3b) 

4 Vj + 2C,C3sine3„ , 

Vj* 4 (S3 - 2C38in02u)* - (C^ + 2C3sin62„)^ - 4C3*cos*62u / 

V,* 4 S3* - 4C3* - 4C3* , 

Vg* 4 (Cj - S3)* - 4 (q + C3)* . 

The relationship of escpressed as a continuous fimction of 
Equation (3-3), for 0 s ^2u * ir is shown in Figure 3.4. 

Since the joints of the meuiipulator will have physical 
limits, the maximum absolute value of <^y will be limited by 
the maximum value of 92u* Referring to Figure 3.4, if we 
in^ose the joint limit of $ 2 x 1 * (3ir/4) radiams, then the 
maximum chamge in 4>y will be of the order of *7.50 degrees. 
Note that the sign of ^y can be reversed by singly traversing 
the closed path in the 02“^3 pisne in the opposite direction. 
If a change in orientation greater tham ^y > 7.5 degrees is 
desired, then the roamipulator joints will have to move along 
some closed path a multiple number of times. This closed path 
cam be foxind as follows: Set the desired chamge in ^y to Q 
where Q - dn, fi denotes the chamge in orientation each time 
the mamipulator traces out a path, n denotes the integer 
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number of times the arm must trace the path. The integer n is 
then obtained by mcocimizing 

5 » Q/n s 7.50 

The value of flju then obtained from Equation ( 3 - 3 ) by 
setting 6 y »6 and using a non-liner function solver to solve 
for the root of Equation ( 3 - 3 ) . Visual examination of Figure 
3.4 will give the range in which the root of the function will 
lie. 

Hence, any changes in orientation of the space 
structure about its' Yg eucis can be achieved through a single 
or multiple closed looped trajectories of class Y motion. 

2 . Z - Class notion 

The purpose of class Z motion is solely to reconfigure 
the manipulator from the "home" configuration to the 
"intermediate" configuration and vice versa. This motion 
makes it possible to change frcmi rotating the structure about 
its' Yg eocis to rotating the structure cd 70 ut its' Xg eucis amd 
vice versa. This will allow the y-x-y rotation sequence 
previously discussed. 

The change in the orientation of the structure about 
its' Zg axis is given by the holonomic Equation ( 3 - 4 ) . 

3 

Is3Az * * 0.25ii^V * rn^io, 51^ * 1^)2] + 4>^) - O , (3-4) 
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which upon integration yields, 


♦z - . )■; . 


Jg23 * Iff 2 


( 3 - 5 ) 


^ ^ ^i22 ^ 0 


The chcuige in orientation negative when the manipulator 
moves from the "home" configuration to the "intermediate" 
configuration. It is positive when the meuiipulator moves from 
the "intermediate" to the "home" configuration. The cdssolute 
value of 4 >g is, therefore, a constant whose value depends upon 
the inertia parameters of the system. 

3. X • Class Motion 

The chcuige in orientation of the structure about its' 
Xg eucis is confuted in a similar fashion as that for the 
motion edsout the Yg axis. All the ec[uations developed for the 
Yg class motion will hold, however, with three changes, 0^ is 
replaced by the constant Sj in Equation ( 3 -la) will have 
Jg22 ^replaced with Ign, cuid A in Equation ( 3 -la) will be 
replaced by -A. denoting the change in orientation of the 
structure about its' Xg axis can be esqpressed as a continuous 
function of ° * ^2u * shown in Figure 3 . 4 . 
Again imposing the limitation of ^2^ « ( 3 ir )/4 radieuis, the 
meocimum chamge in 4 >x vill be of the order s 6.66 degrees. 
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Using the same logic as for (py, we can conclude that 
any arbitrary change in the orientation of the space structure 
about its' Xg axis can be achieved. 

C. SYNTHESIS OF MANIPULATOR MOTION FOR REORIENTATION 

Having looked at how the orientation of the space 
structure changes with motion of the manipulator, the goal now 
is to determine the path necessary for the manipulator to 
traverse, so that we may achieve the desired change in the 
orientation of the structure. As previously discussed, in 
section B, we have chosen an y-x-y scheme to reorient the 
space structure. To do this, consider the following sequence 
of five rotations where the change in orientation of the 
structure about the X^, Yg, and Zg axes are denoted by A^, A2, 
Aj # and A^. 

1 . Class Y motion with <t>y ■ A^ 

2 . Class Z motion with » A2 

3 . Class X motion with 4 >j^ « A3 

4 . Class Z motion with ^ ~^2 

5 . Class Y motion with 0 ^. » A4 

Note that A^, A3, euid A4 are variables; whereas, A2 has a 
constant cQssolute value. This is because, as previously 
noted, the sole purpose of the Z class motion is to 
reconfigure the manipulator arm. 

Looking at this sequence of rotations in detail: Let the 
initial orientation euid the desired orientation of the space 
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structure with respect to the inertial frame be given by the 
rotation matrices and R^, respectively. Then, 


Rl & ( 3 -6a) 

Rf & [y* ^ 3 f]-R [-X, ^2fily/J ( 3 -6b) 

where ( 0 ii»02i»(^ifdenote the set of Euler 
angles describing the initial and the desired orientation of 
the space structure with respect to the inertial frame. Then, 
the set of y-x-y Euler angles (0i,02'^3^ describing the 
desired orientation of the space structure with respect to the 
initial orientation can be solved from the following equation. 

Rly.<t>2^R[x,<l>2]Riy.(l>i] = RfRi"^ ( 3 - 7 ) 

Equation ( 3 - 7 ) has a singularity for (f>2 » 0 , ±7r, . Except for 
this situation, ^3^, <(>2 and ^3 can be solved uniquely from 
Equation ( 3 - 7 ). At the singular configuration(s), the 
orientation of the structure can be trivially depicted by one 
single rotation about the Yg axis of magnitude {4>^ + ^3) for 
02 ” 0, and of magnitude (<t>^ - ^3) for 02 * ± 

Consider the sequence of rotation of the manipulator; 

1 . Class Y motion with 0 ^ « A^. The change in the 
orientation of the structure can be represented by 
■Kty/-^i] • At the end of this motion the manipulator 
returns to the "home" configuration. 

2 . Class Z motion with 0 ^ = A2. A2 is obtained from 
Equation ( 3 - 5 ) as: 
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(3-8) 


A, = 


-(- 

Ih * 2 


The change in the orientation of the structure can be 
represented by . By virtue of this motion, the 

manipulator moves from the "home" configuration to the 
"intermediate" configuration. 

3. Class X motion with * A 3 . The change in the 
orientation of the space structure can be represented by 
I?[x,A 3 } . At the end of this motion the manipulator 
returns to the "intermediate" configuration. 


4. Class Z motion with ~ * ^ 2 , where A 2 is defined by 
Ec[uation (3-8) . The chcinge in the orientation of the 
structure can be represented by 12[z,-Aj] . By virtue of 
this motion, the manipulator moves from the 
"intermediate" to the "home" configuration. 


5. Class Y motion with ■ A 4 . The chemge in the 
orientation of the structure can be represented by 
i2[y,A 4 ] . At the end of this motion the manipulator 
returns to the "home" configuration. 


If the manipulator goes through the sequence of motions 
discussed eUaove, the change in the orientation of the space 
structure would be represented by the rotation matrix. 


Rly,A^]R[z, -A 3 li?[x,A 3 li?[z,A 2 ]i?[y,Ai] (3-9) 


If euiy arbitrary chemge in the orientation of the space 
structure given by Equation (3-7) is to be attained through 
the cdxsve sequence of motions, then we should be 6 d>le to solve 
for A 3 , A 3 , emd A 4 from the following equation; 
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(3-10) 


Riy,f^i\R[z, -Aj]JZ[ jc,A3]J?(2,A2] = 

R iy, ♦a ] ie [x, 4>J ] J? [y, 

for arbitrary values of and 03. Equation ( 3 - 10 ) will 

have a singularity for ^2 « 0 , ±ir. Then Equation ( 3 - 10 ) cam 
be solved by setting Aj ■ A3 « A4 « 0, and actuating A^ » (0^ 
+ ^3) when i>2 • and A^ » (^^ - ^3) when ^3 “ When ^2 ^ 

0 , ±ir, we solve for Aj^, A3, amd A4 by first rewriting Equation 
( 3 - 10 ) as: 

R[z,-ii^]R[x,LAMxA^]R[z,K^] = E[y,^3-A4]E[x,^2]2?[y,^i-Ail ( 3 - 11 ) 

02 ^ 0, ±v 

The product of the matrices on both sides of Equation ( 3 - 11 ) 
is in a direction cosine matrix that cam be equivalently 
represented by the set of four euler parauneters 02 > 
amd 0 ^ [Ref. 10 ] as follows: 

Po = cos(-^), Po = cos(-^)cos( ^ -) ( 3 - 12 ) 

A AW 

P 3 = sin(-^)cosA 2 , Pi * sin(-^)cos( ^^ (3-13) 

A A A 

P2 - sin(-~)sinA2 , P2 = cos(•%) sin () ( 3 - 14 ) 

2 2 2 

P. -0, S3 - sin(.fe)Bln( t^~*«~*i*'*i ) ,3.jL5, 
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Since 0, ±v, Equations (3-12) through (3-15) can be 

solved for A^, A 3 , and A 4 as follows: 

Aj = ~ arctauitsinAj tan(A 3 / 2 )] , (3-16) 

A 3 = 2 arcsin(sin(<|> 2 / 2 ) secAjl / (3-17) 

A4 « Aj + <|>3 - . ( 3 - 18 ) 

The algorithm for the reorientation of the space structure 
can, therefore, be established as follows: First solve for 
the necessary change in the orientation ^ 2 ' ^3 

Equation (3-7) . Next confute the values of A^, A 3 , amd A 4 
from Equations (3-16) through (3-18) using the coinputed values 
of 4>2 and 03 . For each of A,^, A 3 and A 4 , confute the 
closed trajectory in the 62'^3 ^Ae number of times 

that the nanipulator has to traverse the closed trajectory. 
Such trajectories caui always be plaxmed. Now that the 
trajectories are )cnown we can follow the five step motion 
sequence to achieve the desired chemge in orientation of the 
structure. 

D. SZKDLATXON BBSULTS 

A simulation was conducted for a large angle mauieuver of 
an arbitrairy space structure where the manipulator had the 
following (cinematic parameters, according to Figure 3.1b 
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r = 


0.35 m, I 2 


0.40 m 


0.15 m, Ij = 


= 0.50 in, Ij = 


The dynamic parameters used are given in Table 3.1. The 
initial and desired orientations of the space structure, given 
in degrees were: 


® (135.0,25.0,-105.0) (3-19) 


= (-55.0,95.0,75.0) (3-20) 


This yielded the following y-x-y Euler angles: 

Aj = -66.79483, 

Aj = -11.09346, (3-21) 

A 3 = 123.43739, 

A^ » 89.83769 

From the orientation and Euler angles, Aj^, A 2 , A 3 auid A^ were 
obtained as follows: 


(♦i/* 2 '^ 3 > * (-86.47308,113.57773,70.15945) (3-22) 

where the xinits are in degrees. 

The orientation of the structure at the beginning and the 
end of each of the five sequences of rotations is as shown in 
Figure 3.5. The description of the closed loop path in the 
space is as shown in Figure 3.6. As the manipulator 
traces out the path, as described in Figure 3.6, the evolution 
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of the Euler angles with respect to time is illustrated in 
Figure 3.7. 


1 . Class y motion with A-^ = -66.79483 degrees. The minimum 
number of times the robot has to move along a closed 
trajectory will be n = 9. Then, for each closed loop 
motion the change in orientation needs to be -66.79483/9 
= -7.42164 degrees from Figure 3.4, we find that <t>y = 
+7.42164 degrees corresponds to a value of $ 2 ^^ that lies 
between 125.0 and 135.0 degrees. Using these values as 
the lower and upper limits, we find the exact solution 
for 4>y - 7.42164 in Elation (3-3) to be 133.84235 

degre^. The negative sign in the change in orientation 
can be taken care of by simply travelling along the 
closed path in the negative direction. 


In Figure 3.6 ABCDA denotes the directed closed path in 
the do -63 plane. The change in the y-x-y Euler angles 
$ 2 ' ^ 3 ^ shown in Figure 3.7 during the time t = 
0 seconds to t = 483.92 seconds. It can be seen from 
Figure 3.7 that during this time and <t >2 remain 
constant, whereas 4)^ changes with a periodic motion. The 
number of periods is equal to nine and corresponds to 
the number of times the second and third joints of the 
robot move along the closed path ABCDA in Figure 3.6. 
The configuration of the system at the start and finish 
of this motion is shown in Figure 3.5(a) and(b). 


2. Class Z motion with A 2 » -11.09346 degrees. In Figure 
3.6, the path segment AO corresponds to the motion. The 
variation of the y-x-y Euler angles during this motion 
are not very clear from Figure 3.7 because this motion 
takes only 10 seconds to complete, as compared to the 
total time of simulation which is of the order of 2166 
seconds. Figure 3.5(b) and (c) show us the configuration 
of the system at the beginning and the end of this 
motion. 


3. Class X motion with A 3 = 123.43739 degrees. The minimum 
number of times the robot has to move along a closed 
trajectory will be n « 19. Therefore, for each closed 
loop motion the change in the orientation needs to be 
123.43739/19 - 6.49670 degrees. From Figure 3.4, we find 
that <P- - -6.49670 degrees corresponds to a value of 62 ^ 
that lies between 125.0 and 135.0 degrees. Using these 
values as the lower and upper limits we find the exact 
solution for - -6.49670 to be 132.19918 degrees. 
Since travelling along the positive direction of the 
closed path produces a negative change in the orientation 
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as evident from Figure 3.4, we will travel in the 
negative direction. In Figure 3.6, OPQRO denotes the 
directed closed loop path in the 9 2'^2 pla^ne. The change 
ih'the y-x-y Euler angles <l> 2 , ^ 3 ) is shown in Figure 

3.7 during the time t = 493.92 seconds to t = 1509.27 
seconds. It can be seen from the figure that all the 
Euler angles undergo a periodic motion during this time. 
The ntimber of periods can be seen to be equal to nineteen 
and equals the number of times the second and third 
joints of the robot move along the closed path OPQRO in 
Figure 3.6. The configuration of the system at the start 
and finish of this motion is shown in Figure 3.5(c) and 
(d) . 

4. Class Z motion with A 2 = 11.09346 degrees. In Figure 
3.6, the path segment OA corresponds to this motion. The 
variation of the y-x-y Euler angles during this motion 
are not very clear from Figure 3.7 because this motion 
takes only 10 seconds to conplete, as compared to the 
total simulation time which is of the order of 2166 
seconds. Figure 3.5(d) and (e) show us the configuration 
of the system at the beginning and end of this motion. 

5. Class Y motion with Aj^ = 89.83769 degrees. The minimum 
nvimber of times the robot has to move along a closed 
trajectory will be n >= 12. Then, for each closed loop 
motion the change in the orientation needs to be 
89.83769/12 » 7.48647 degrees. From Figure 3.4, we find 
that <t>y = 7.48647 degrees corresponds to a value of $ 2 ^ 
that lies between 125.0 euid 135.0 degrees. Using these 
values as lower amd upper limits, we find the exact 
solution for = 7.48647 in Equation (3-3) to be 
134.73799 degrees. In Figure 3.6, AMNBA denotes the 
directed closed loop path in the ^ 2"^3 plane. The change 
in the y-x-y Euler angles {4>x, 02' ^ 3 ^ shown in Figure 
3.7 during the time t ■ 1519.27 seconds to t = 2166.64 
seconds. It can be seen from the figure that during this 
time the Euler auigles 0^ and 02 remain constant whereas 
03 chcuiges with a periodic motion. The ntunber of periods 
can be seen to be equal to twelve and it equals the 
number of times the second and third joints of the robot 
move along the closed path AMNBA in Figure 3.6. The 
configuration of the system at the start and finish of 
this motion is shown in Figure 3.5(e) and (f). 

We have thus effectively demonstrated a new method for 
attitude control of a freely-floating space structure via a 
surface integral approach. The next chapter will address the 














Figure 3.1(a): The Home Configuration of the Three Link Robot 
Manipulator Mounted on the Space Structure is 
Shown. The Link Frames are According to the 
Denavit-Hartenburg Convention. 



Figure 3.1(b): Kinematic Structure of the 3-Link Robot 
Manipulator with Revolute Joints. The Home 
Configuration of the Itemipulator is Shown. 
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Satellite Configurations (a 
Configuration with 
Intermediate Configuration with 

















^2u (deg) 


Figure 3.4: For the Simulation in Section D, the Cheuige in 

the Orientation of the Space Structure about 
its X and y cuces: 0^ emd ^ respectively. 
Depends Upon the Dimension of the Rectangular 
Path in the Plane. 
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TABLE 3.1: DTNMIZC PARAMETERS OP THE 3-R MANIPULATOR 

Ikij (kg-a^). 



k-S 

H 

■ 

M 

k>2 

k-3 

(1,1) 

23.95781 

00.0830 

00.0147 

00.0117 

(2,2) 

13.87031 

00.0103 

00.2343 

00.1221 

(3,3) 

37.82812 

00.0830 

00.2343 

00.1221 

JSlI^ _ 

302.6250 

7.62615 

10.8945 

mmm 



' 4 , 






42 































Flgur* 3.€t Description of the Closed Loop Path in 

Space that Changes the Orientation of the 
Space Structure from an Initial y*x-y Euler 
Jingles of (135.0, 25.0, -105.0) Degrees to a 
Final Value of (-55.0-95.0, 75.0) Degrees. 
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•Pz. 03 (deg) 


Flgnr* 



3.7; Evolution of the Euler Angles 0^^, 02, 03 

Describing the Orientation of the Space 
Structiire, for the Simulation in Section D. 



IV. " PLANNING REPEATABLE PATHS FOR PLANAR SPACE ROBOTS 

A. INTRODUCTION 

In Chapters I and III, we saw that due to the nonholonomic 
nature of a freely-floating space structure the use of an 
organic manipulator will result in a change in the orientation 
of the structure. Automation in space requires the ability 
for a space robot to perform a task repeatedly in its work 
space without any drift in its configuration variables, i.e., 
joint angles, orientation, and end-effector position. Hence, 
the resultant change in orientation of the structure as the 
manipulator arm performs a required task, which we exploited 
in Chapter III for attitude control, is undesirable for 
automation. 

In Chapter II we proposed; (1) that integrability of the 
differential constraint is only a sufficient condition for 
repeatability, but it is by no mecuis a necessary condition, 
emd (2) that a necessary condition for repeatable motion was 
that the fiinction F defined by Equation (2-10) be equal to 
zero. 

This chapter will apply these ideas to a two dimensional 
space robot. The two dimensional case is studied purely for 
its simplicity. 
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B. NECESSARY CONDITION FOR REPEATABILITY 


Not all nonholonomic systems exhibit pseudo-holonomic 
behavior. Consider the rolling disk shown in Figure 4.1 [Ref. 
8]. The two nonholonomic constraints are given by: 

dx - r sina d(9 (4-la) 
dy - r cosa dO (4-lb) 

Rearranging Equation(4-1) for the change in the dependent 
variables x and y for the closed loop motion of the 
independent variables 6 and a we get: 

f dx - { r sina d0 (4-2a) 
I dy » J r COSO d9 (4-2b) 

where F(o,9) a { sino, coso }. Since F(a,9) will not equal 
zero at euiy point in the space of 6 and o it will not satisfy 
the condition for repeatability, consec[uently it does not 
admit repeatable motion. 

In the case of a planar space robot with two links, shown 
in Figure 4.2, the nonholonomic conservation of momentum 
constraint equation is given by Equation(4-3). 


“ (Bj, © 2 ) ®2^ ^®2 


(4-3) 
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where 

0 Q - the orientation of the space vehicle, 

and $2 * the joint variables of the manipulator, 

A, B, C * functions of and 62 as defined in Appendix A, 

r » the position of the joint of the first link with 
respect to the center of gravity of the body, 

* the length of the first link, 

J » the length of the second link, 

m 2 are the masses of the rigid body and the two 

links, 

Iq, 1 ^, I 2 are the moments of inertia of the rigid body 
and the two links cd>out their respective centers of mass, 

M ^ mQ + Ml + m2 , cuid 

“ Iq + + I2 • 

Applying Stoke's theorem to Equation (4-3) we get 


= ff 

Jjs 


(4-4) 




where S is the region enclosed by the path C in the joint 
space of the robot which the meuiipulator arm traces. We Cem 
show that A 0 therefore Equation (4-4) will satisfy the 
necessary condition for repeateUbility if; 


^(01, 62 ) A [A 




86 




= 0 


(4-5) 
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where 9^ 0. 

To find the "holonomic loop", on which the planar space 
robot exhibits holonomic behavior globally, we need find the 
values of 6 ^^ auid $2 which set Equation (4-5) to zero. To 
determine the appropriate values of 6 ^ and 62 • choose path 
in the robot joint space, which we desire the robot to 
execute, such that it encloses at least one point where the 
function F goes to zero. This path can then be optimized by 
using a variety of niomerical optimization techniques to drive 
Equation (4-5) to zero. In simulation we choose to use (1) an 
elliptical path as the most general case of a path; and, (2) 
the steepest descent optimization technique for its 
sin^licity. 

The elliptical path, shown in Figure 4.3, was 
parameterized as follows: 

" ®io * ^ COS0 cos27rt - b sin0 sin27rt, t e [0,1] (4-6a) 
^2 " ^20 ^ sin^ cos27rt + b cos^ sin2Trt, t € [0,1] {4-6b) 

where a and b are the semi-major and semi-minor axes of the 
ellipse respectively, 4 > is the angle of inclination of the 
ellipse with the cocis, and 620 a^re the coordinates of 
the center of the ellipse. Substituting Equation (4-6) and 
its time derivatives into Equation (4-4) , d$ can be expressed 
as a function of the single variable t such that we get: 
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J d^o * i + 92^1^2) 

= I Cgi^i + 92^2^ 

To optimize the path we need to: (1) arbitrarily choose 
the parameters, ^j^q, djo' ^ ellipse; and, 
(2) to change the five parameters so that the value of the 
surface integral given by Equation (4-7) is equal to zero. 

In making the initial choices of the ellipse parameters, 
we needed to ensure that: (1) the ellipse enconpasses at least 
one point where the function F defined by Equation (2-10) is 
equal to zero. This cam be satisfied by considering Figure 
4.4, which provides the set of all points where the function 
F vanishes; and, (2) the elliptical path lies in the work 
space of the robot. This can be done by applying the methods 
discussed in [Ref. 23]. 

For the optimization, to eliminate the trivial solution, 
where the surface integral is zero, because the area of the 
closed path is ec[ual to zero, we inqposed the restriction that 
the area of the ellipse was constant. In other words, a and 
b were not allowed to change independently of each other. 
This imposed the added constraint, 

a db -i- b da - 0 (4-8) 
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We define a function V as follows: 


V‘ C . C A f F(0i,e2)d0iflB2 

and solve the unconstrained minimization problem by In^llcltly 
assuming that a amd b are dependent. 

The steepest descent method Involved numerical partial 
differentiation to change the parameters of the ellipse auid to 
solve the unconstrained minimization problem where; 


' 

(4-10a) 

' 

(4-10b) 


(4-lOc) 


(4-lOd) 


This provided a systematic way to reach the local minimum 
value of the fxmctlon V. If this minimum value Is zero, then 
we have found the "holonomic loop". Though In general, the 
method of steepest descent does not guarantee the convergence 
of a function to its global minimum value. In our case the 
method always converged to a minimum. This was due to the 
particular nature of the fxmction F. 
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C. SnCDLXTION RESULTS 

A simulation was conducted for a planar space robot which 
had the kinematic and dynamic parameters given in Table 4.1. 
The initial parameters of the ellipse were chosen to be: 

a=l.50000, b=l.00000, 

0.75000, 

^ 10 = 0 - 50000 , ^ 20 = 0-50000 

The initial and optimal path parameters yielded the paths as 
shown in Figure 4.5. Path I and II correspond to the initial 
and optimized path paraimeters, respectively. Path I yielded 
the niunerical value for Equation (4-9) of = -0.162775. The 
optimized path parameters were; 

a»l.31117, b=l.14381, 

4>-0.79302, 

010=0-34094, 02O=’O-O7O54 

yielding f = -9.9636 * 10*^. Note that the sinusoidal curve, 
F{0 i, 02) * 0, inset in Figure 4.5 passes through both Paths I 
and II, therefore, both paths satisfy the necessary condition 
for repeateOaility. Several simulations were carried out and 
in all cases the "holonomic loops" were found. 

By finding the "holonomic loop", control of the attitude 
and, hence, the end-effector of the manipulator was obtained. 
The drift in the end-effector of the manipulator for the 
original path and optimized path are given in Figures 4.6 and 
4.7, respectively. The magnitude of the drift in the case of 
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Path I is 76.96 mm/cycle. The magnitude of the drift in the 
case of Path II is negligible at 0.87 mm/cycle. 
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Figure 4.It A Rolling Disk on a Flat Surface. 
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Space Vehicle 




A Planar Space Robot with Two Links is 
CapeQ>le of Exhibiting Pseudo-holonooiic 
Behavior. 

















TABLE 4.It KINEKATIC AED DYSAMIC PARAMETERS 



Mass 

Inertia 

Length 

ikgfi 

(Jtg-rf) 

(jb) 

Vehicle 

27.440 

1.520 

r > 0.20 

Llnk-1 

5.380 

0.115 

li - 0.50 

Link* 2 

2.640 

0.028 

1, m 0.35 
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Figura 4.5 Elliptical Paths in Joint Space. 
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y coordinate of end-effector (m) 







y coordinate of end-effector (n») 







V. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 

This thesis has presented two concepts. The first being 
a algorithm for the motion planning of a space manipulator to 
achieve attitude control of a freely-floating three 
dimensional space structure. Generally stated the algorithm 
provided a meauis for calculating the coordinate trajectories 
required to drive a nonholonomic system from one point in its 
configuration space to some other desired point. The 
algorithm invoked Stokes' Theorem and hence took a surface 
integral approach to the motion planning problem. In 
particular, we considered a three dimensional structure with 
a three link manipulator arm. 

Due to the nonholonomic nature of structures in space, 
articulated joint manipulators can effectively be used as a 
back-up means to a gyroscope for the attitude control of these 
structures. Attitude control is achieved through the motion 
planning of the internal motion of the manipulator arm joints. 
We found the surface integral approach to be a single and 
effective means to solving the motion pleuining problem. 

Secondly, we presented a means of determining the 
manipulator motion required for the nonholonomic freely- 
floating space structure to behave in a holoncmiic manner. 
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which we called "pseudo-holonomic". Our method determined if 
"holonomic loops" existed, where the system exhibits holonomic 
behavior globally for the configuration space of the 
nonholonomic system. If a "holonomic loop" did exist we 
presented an algorithm for finding that loop within the 
configuration space. In this case, we looked at a planar 
space robot with a two link manipulator arm. 

Additionally, though the nonholonomic nature of the space 
structure does not normally admit repeatable motion, it is 
possible, however, to find exceptions to the rule where 
systems do exhibit holonomic behavior globally. Finding the 
"holonomic loop" in the joint space of the manipulator 
admitted repeatc±»le motion of the space robot. Hence, we have 
seen, that manipulators can effectively serve the dual purpose 
of attitude control and automation in space. 

We have demonstrated the ability to predict and control 
the change in orientation of a freely-floating space 
st3mcture. 

B. RECOMMENDATIONS 

The application of the two algorithms to more conplicated 
structures is the next logical step. The approach presented 
here can be extended to other nonholonomic systems such as 
mobile robots- The finding of "holonomic loops" can be 
further extended to the three dimensional space structure with 
eui attached three linked manipulator arm. 
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APPENDIX A 


The terms A, B, and C in Ec(.(2) are defined as follows 


-4 * /t +• •r 7 >'*'no(rni + »nj) + "-frCjfioWi + n»imj +4mo>»n) + + f^i) 

ivi 4iW 4«V/ 

+ 77 mo(mi + 2mi)rlico$ 0i + —m^fnio +0.Smi)f|/3COjd2 + -^mom^r/jcoaffli +O 3 ) 
iVi Ai Ax 


& 1* fo 2 

fl = /i + /j + —^(mortii + mi/na + mo/nj) + T77”»a(xno + xi»i) + -r^/noffni 4-2m2)r/icoitfi 
4A'/ 4Aj aW 

+ —mj(mo +0.5fin)ii/2COji5*2 + + ^ 2 ) 

Ai 2Ai 


C — [-i + 4- + ^^w«o'»‘alilacojt02 + ^j^inctnirl2cos{0i + O-^) 


where, mo. mt, and m-j are the masses of the space vehicle and the two links of the ma¬ 
nipulator, /o, h, and h are the moment of inertias of the space vehicle and the two links 
about their center of masses, r is the distance of the first joint from the center of mass of 
the vehicle, h anti I 3 are the lengths of the two links, M * mo+Tm -t-mj, and f, * /o + /i 4 -/j. 
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